analytical inverse kinematics for 2 DOF planar arm